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Аннотация 

Введение. Исследуется задача управления движением экзоскелета нижних конечностей. Для ее решения 
предлагается задействовать программное управление и управление в виде обратной связи. Формирование 
управления в виде обратной связи требует оценки состояния экзоскелета (углы поворота, угловые скорости и 
ускорения звеньев). Рассматривается возможность применения блока инерциальных датчиков для оценки 
угловых скоростей и ускорений звеньев экзоскелета. Цель работы — определить законы формирования 
управления движением экзоскелета, которые обеспечат устойчивость программного движения и будут 
использовать измерения энкодеров, микромеханических гироскопов и акселерометров. 

Материалы и методы. Ранее выполненное математическое моделирование динамики экзоскелета 
задействовали при формировании программного управления. Предложили оснастить экзоскелет блоками 
инерциальных датчиков. Это решение позволяет оценивать вектор состояния экзоскелета и использовать 
данные оценки в цепи обратной связи. Описали математическую модель измерений указанных датчиков. 
Предложенный вариант пригоден для систем управления трехзвенными экзоскелетами нижних конечностей и 
может быть расширен для многозвенных. 

Результаты исследования. Предложены новые законы управления движением экзоскелета, основанные на 
математической модели динамики системы и использующие измерительную информацию с энкодеров и 
инерциальных датчиков. В математическом пакете \УоШат МафетаНса выполнено численное моделирование 
движения экзоскелета. Его итоги подтвердили работоспособность предложенного управления и возможность 
использования блока инерциальных датчиков для оценки состояния экзоскелета. Приводятся результаты 
численного моделирования для следующих программных движений: подъем экзоскелета из положения сидя в 
вертикальное и стабилизация вертикального положения равновесия. 

Обсуждение и заключения. Предлагаемое управление применимо в экзоскелетах для медицинских 
приложений (например, в задаче вертикализации пациентов с нарушениями функций опорно-двигательного 
аппарата). Показана возможность использования измерительной информации, полученной от блоков 
инерциальных датчиков, в задаче оценки состояния звеньев экзоскелета. Применение инерциальных датчиков 
позволит определять угловое ускорение звеньев экзоскелета, избегая численного дифференцирования 
измерительной информации, полученной от энкодеров. Оценки углового ускорения позволяют вводить в 
систему управления обратную связь по угловым ускорениям, что открывает возможность улучшить 
переходные процессы при управлении движением экзоскелета. 
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Введение. Разработка и применение экзоскелетов — устройств, предназначенных для облегчения движения 
и повышения двигательной эффективности человека, — перспективное направление развития робототехники. 

Экзоскелеты все шире применяются в промышленности [1], военном деле [2], медицине [3] и других 
областях. Этим обусловлена актуальность исследований, посвященных их схемотехническому и 
конструкционному исполнению, оптимизации энергозатрат, траектории движения, динамике, управлению. 

В представленной работе рассматривается активный экзоскелет нижних конечностей человека с жесткой 
конструкцией силового каркаса. Его используют для реабилитации пациентов с нарушениями функций опорно- 
двигательного аппарата. 

При разработке таких экзоскелетов возникает необходимость решения взаимосвязанных научно- 
технических задач. В их числе: 

— формирование скелетной схемы; 

— математическое моделирование движения экзоскелета [4—6]; 

— оптимизация движения звеньев на основе математической модели кинематики и динамики '; 

— рациональное построение двигательной системы [7, 8]; 

— разработка алгоритмов управления [9-11] и оценивания [13, 14]. 

Все перечисленные задачи связывает проблема поиска управляющих воздействий для программного 
движения. Их источником может быть, во-первых, динамическая модель системы. Во-вторых, они 
формируются в виде пропорционального интегрально-дифференциального (ПИД) регулятора, используемого 
для стабилизации программного движения. Возможна также комбинация двух способов. При этом для 
формирования управления по принципу обратной связи (в частности в виде ПИД регулятора) важную роль 
играют алгоритмы оценивания состояния динамической системы и набор датчиков, показатели которых 
используются в алгоритмах. 

Для получения информации о положении звеньев экзоскелетов их оснащают энкодером или 
гироскопом [9-14]. Другие возможные варианты: акселерометр, магнитометр, потенциометр, датчики момента, 
силы, биосигналов и др. 

В [13] на каждом звене экзоскелета предлагается использовать по одному блоку инерциальных датчиков, 
состоящих из гироскопов и акселерометров. Такое решение позволит оценивать углы поворота, угловые 
скорости и ускорения. При этом модель измерений получается нелинейной, что усложняет структуру систем 
управления и наблюдения. 

Цель работы — улучшение управления экзоскелетом за счет использования двух инерциальных блоков, 
закрепленных на каждом звене экзоскелета. Такой подход позволяет оценивать углы поворота, угловые 
скорости и ускорения экзоскелета. С помощью предлагаемого варианта расположения гироскопов и 
акселерометров можно получить линейную модель измерений, что откроет пути для упрощения системы 
управления и применения теории оптимального оценивания линейных систем [15]. Это, в свою очередь, станет 
базой для совершенствования управления движением экзоскелета. Критерий улучшения качества 
управления — уменьшение отклонений угловых скоростей звеньев от программного движения. 

Материалы и методы. Рассмотрим кинематическую схему экзоскелета с жесткой конструкцией силового 


каркаса при симметричном движении ног в сагиттальной плоскости (рис. 1). 


' Оптимизация времени вертикализации экзоскелета по критерию энергоэффективности / С. Ф. Яцун [и др.] // Вибрационные технологии, 
мехатроника и управляемые машины. Курск : Изд-во Юго-Зап. гос. ун-та, 2016. Ч. 2. С. 151-160. 
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Рис. 1. Кинематическая схема экзоскелета нижних конечностей в сагиттальной плоскости 


С›, Сз, С. — центры масс голеней, бедер и корпуса соответственно; Ат, 42, Аз — шарниры, соединяющие 
звенья экзоскелета; ф›, фз, ф4 — углы поворота звеньев экзоскелета; М>, Мз, М. — управляющие моменты, 
создаваемые приводами, расположенными в шарнирах А|!, А›, Аз соответственно. Для описания движения 
вводится система координат ху. Ось х направлена вдоль опорной поверхности, у — вдоль местной вертикали к 
опорной поверхности. Ось < дополняет координатные оси до правой декартовой системы координат. 

В качестве основы для построения системы управления движением экзоскелета используем динамическую 
модель из [6]. 


А(9)4+Е(а)4` +Ра+Р(а) =М. (0) 
Здесь: 
7» Т.. с0з(Ф, —Ф;) 75, с0$(Ф. -Ф.) 

А(а)=| 1; соз (> —$. ) Та Т.. с0$ (Ф- —ф.) | — матрица инерционных сил; 

Т», оз (Ф› —Ф. Т; 0$ (ф: —Ф.) Та 

0 1; зт(ф. -Ф.) 1. эт (Ф> —ф.) 

Е(а)=| -7,, яп (Ф, -$.) 0 7„зт(ф. -Ф.) | — матрица скоростных сил; 

7, зи (Ф. —ф.) 7 зт(ф: —ф.) 0 
Р = Фа (и. ии.) — диагональная матрица диссипативных сил, характеризующих линейное трение в 
шарнирах; Р (а) = (Ме с0$ф,› Мс. с0$ф. Мс. с05Ф, ) — вектор-столбец моментов, возникающих от 
действия сил тяжести; М= (м, —М, М, М, М, у —щ  вектор-столбец управляющих моментов, 


т 
создаваемых приводами, которые расположены в шарнирах звеньев экзоскелета; а = (> ф. ф.) — вектор- 
столбец обобщенных координат, состоящий из углов поворота звеньев экзоскелета; ] ж ( ЪКк=2, 3,4) — 
моменты инерции звеньев экзоскелета; му (к =2, 3,4) — коэффициенты линейного трения в шарнирах звеньев 


экзоскелета; Ма (к=2, 3,4) —Щ_ Максимальные величины моментов гравитационных сил, воспринимаемые 


выходными звеньями приводов. 
Пусть заданы законы изменения углов и их производные при программном движении: 


р р .Р _ „Р ИР (р ь 

ф; =Ф, (0), ф; =Ф, (0, ф; =Ф; (0). (: =2, 3,4) . (2) 

Для управления движением экзоскелета предлагается формировать управляющие воздействия в виде суммы 
управляющих моментов: 


— при программном управлении М? =М, (7.67.6!) (1 =2, 3,4) : 
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Р 


— ПИД регулятора МР? =М, ($! ф.,ф’ ф., 6: $,).(=2,3,4). 
М, =М+МеР, М, =М+М"Р, М, =М+МР. (3) 


Для программного управления значения управляющих воздействий М? можно рассчитать по формулам [7]: 
М; = Мол с08 Фу + ра ф + 14$ +7. [$ 605 (6—9: )-($>) 51(9 -9!) |+ 
: р)? . 
+ы | $ 605 (©: $! )-($:) 5т(® -9!) | 


М} =Мо 60$ <; + фз + 7,61 +7, [$ 605 (<: —$9:)-($) 51 ($ -9!) |+ 


(4) 
+3 [$103 (9;-91)+ (61) ят(9: 9!) |+МЕ, 
МЕ = Мозооъо! +р! +161 +1. |7 0597 —0")+ ($1) зо! 9!) |+ 
+791 0059! —91)+ (61) зи\(о! 9: |+М!. 
Величины М”? вычисляются по принципу обратной связи (в форме ПИД регулятора): 
р 
Му? — К. (# $.) Кы (6: -$.)+Ка ($: <) $. (6) ав, 
0 
1 
м! = Кы “($ -$)+К» (91 -6,)+Кь (674) Фан м”, 6 
0 
р 
м! = Ко: ($: -$,)+Кы ($: $.) К (97), ))ан +мт?, 
0 


ИЛИ 


РР Г .. Ра | Р : РЮО 
М; =Кь ($ $, )+Кь ($: $.) К (®: ©) М. , (6) 
РЮО „.Р .. ‚Р В Р И РР 
М, =Кь ($, $, )+ Кр (© $) К» (©, ©, М; . 
Здесь коэффициенты ПИД регулятора Кр, Ки, Кр; (= 2, 3, 4) могут быть: 
— постоянными (их находят из условий устойчивости); 
— функциями времени (находят из решения задач оптимального управления) [9, 13]. 
Одна из проблем формирования управляющих воздействий в виде ПИД регулятора — возможные 
погрешности при дифференцировании измерительной информации. Чтобы их избежать, используем: 


— энкодеры (для измерения текущих углов поворота ф, звеньев экзоскелета); 
— блоки инерциальных датчиков из микромеханических гироскопов (для измерения угловых скоростей ф; ) и 


акселерометров (для оценки угловых скоростей Ф; и ускорений 6, ). 
Модель измерений углов поворота с помощью энкодеров можно представить в виде: 
Фе =Ф5› Фьз ТФь =Фз, Фы +Фь ТФь> = 4, (7) 
где Ф..,Фь-,ФЕ. — показания энкодеров, расположенных в шарнирах А\1, 4, Аз (рис. 1). 
Модель измерений угловых скоростей с помощью микромеханических гироскопов можно записать в виде: 
©, =$,, О, =ф, Ом =Фь, (8) 
где Ос», Осз, Ос4 — показания гироскопов, закрепленных на звеньях экзоскелета. 
Для оценки угловых скоростей и ускорений с помощью акселерометров можно использовать по два 
двухосевых акселерометра, которые расположены на противоположных концах каждого из звеньев. Они 
измеряют в проекциях на оси х; у; (1 = 1, 2, 3) кажущиеся ускорения, связанные с соответствующими звеньями. 
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ЕЕ 


т 
га. =[6,-5%,) (о, | = —м), 


т 
т 
А ФА _[[еА СА, А РА, И 22 к 
РАЗА, о [я АРА, ). в вы. = (5$ 1,$, , (9) 
| т 
с Аз _[(+С РА С РА, а а 
Ас (> 2%) Е в = (15$: 1-$. . 
А А, й 
Здесь Р.Г, — векторы показаний двухосевых акселерометров, закрепленных на звене А.А, и 
‚› РА ь 
расположенных в точках А, и А, соответственно; Е — векторы показаний двухосевых 


акселерометров, закрепленных на звене А.А, и расположенных в точках А, и А, соответственно; 


Аз С з 
Ас» лс —щ векторы показаний двухосевых акселерометров, закрепленных на звене А.С и расположенных в 


‚= |А,А. 


точках А, и С соответственно; 1 =|А.А, ‚5 =|А.С| — расстояния между парами акселерометров, 
закрепленных на звеньях А,А,, А.А, и А,С соответственно. 


Объединим уравнения (7)-(9) и запишем формулы для оценки углов поворота, угловых скоростей и 


ускорений: 
ф, =Фь>› Ф: =Фьз +Фь>, Ф. =Фь. +Фь: +Фь>, $. =Оз,, Ф=Ос, Фф. =О., 
(А, 1%) (2 в», ) (2-5) (10) 
ф, = у $. = = ф.=- = 
1 | Ь у, 
Для коррекции оценок модулей угловых скоростей можно использовать уравнения: 
[в Е в = 1$>, [6 = в. ). — о, т к в. ) = 153. (11) 


Таким образом, для оценки углов поворота, угловых скоростей и угловых ускорений звеньев экзоскелета 
можно обработать измерения фильтром скользящего среднего, алгоритмом фильтра Калмана и др. [10, 13, 15]. 

В самом простом варианте замыкания цепи обратной связи при формировании управления получим 
выражения для управляющих моментов: 

С А; 

Р Р (с Ах ). Р Р 
_ ; : : | 
М, =М. +Кь.| 4 + ЕК 4 ($: О) "Ка (е: Фе4 — Фвз фаз} 


М, =М, +К.з | $: ЕК 3 (© О, "К ( Фез Фь, | М. ›, (12) 


М, =М, +Кь,| $2 + - +К > (©; 9 Кр (®, Фе, ) ВМЗ”. 


Введение в систему управления обратной связи по угловым ускорениям позволяет применить 
диагонализацию матрицы инерционных сил для снижения перекрестного влияния между обобщенными 
координатами. 

Смоделируем движения экзоскелета для проверки работоспособности предложенного закона управления. В 
качестве программного движения рассмотрим: 

— смену положения из сидячего в стоячее [7]; 

— стабилизацию вертикального положения экзоскелета при начальных отклонениях звеньев от вертикали. 

Результаты исследования. Для численного моделирования системы возьмем параметры математической 
модели экзоскелета из [6, 7]. Рассмотрим частный случай, выбрав одинаковые коэффициенты ПИД регулятора 


для каждого привода: К» =1000Н-м-с, К, =1000Н-м, Ку =ОН-м/с (1 = 2,3,4) р 
На рис. 2 приведены зависимости от времени для углов поворота и угловых скоростей звеньев экзоскелета. 
Их получили при управляющих моментах, соответствующих подъему из положения сидя. Как видно из рис. 2 а, 


по окончании движения углы поворота каждого звена равны Ф, =ф. =ф, = 90° ‚› Что соответствует стоянию. 
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ф,° ф.°/ 
30: ф. 
150 20. 


100. 


50 


а) 6) 


Рис. 2. Результаты моделирования подъема из положение сидя без начальных отклонений от программного движения в 
углах поворота звеньев экзоскелета: а — углы поворота звеньев; 6 — угловые скорости звеньев 


Теперь рассмотрим случай с отклонениями около 20° в углах поворота звеньев по сравнению с начальным 
положением, заданным в программном движении. Результаты моделирования подъема из положения сидя 


приведены на рис. 3. Как и на рис. 2, по окончании времени движения значения углов поворота равны 


ф› =ф, =Ф, = 90°. Следовательно, использование комбинации программного управления и управления в виде 


ПИД регулятора точно приводит экзоскелет к требуемому положению. 
ыы а - 
Ф; 2 ФФ, | $ 


200\ 
150. 
100! 


501 


Рис. 3. Результаты моделирования подъема из положения сидя при начальных отклонениях от программного движения в 
углах поворота звеньев экзоскелета: а — углы поворота звеньев; 6 — угловые скорости звеньев 


Таким образом, при моделировании программного движения показана работоспособность предложенного 
закона формирования управляющих воздействий, описанного в (4) и (12). 

Вертикальное положение экзоскелета неустойчиво без управления, поэтому возмущающие факторы могут 
обусловить отклонения от равновесия вплоть до падения экзоскелета. 

Проверим работоспособность предложенного управления в задаче стабилизации вертикального положения 
экзоскелета. Значения для программного движения: 6%() =$'()=ф4(9 =90°. Рассмотрим случай, когда в 


углах поворота звеньев есть отклонения около 20° от вертикального положения (рис. 4). 
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Фив 


ТВ В ЗВ В [ЗВ ЗВОНА ТВ Е Е ВЕТ ВЕ ВАТ ОЕ В НЕЕ НЕ В ЕАГИЕ 


и 4 6 8 10 12 14 6$ 
а) 6) 


Рис. 4. Результаты моделирования стабилизации вертикального положения при начальных отклонениях от программного 
движения в углах поворота звеньев экзоскелета: а — углы поворота звеньев; 6 — угловые скорости звеньев 


Из рис. 4 видно, что предложенное управление обеспечивает стабилизацию вертикального положения 
звеньев экзоскелета. 

Для сравнения приведем результаты моделирования стабилизации вертикального положения при 
использовании следующих значений коэффициентов ПИД регулятора: К» =1000Н-м:с, К, =1000Н.м, 


Кы =100Н-м/с (1 — 2,3,4) (рис. 5). 


ф° 
120. 


5 
40- 


20- 


ОЗ В А В В ЗВ В В В В РОВ ВВ ЕВ АТ ВР ВЕ ЗВ СВР 


2 4 6 8 1 1 12 14 26$ 
а) 6) 


Рис. 5. Результаты моделирования стабилизации вертикального положения при начальных отклонениях от программного 
движения в углах поворота звеньев экзоскелета: а — углы поворота звеньев; 6 — угловые скорости звеньев 


Из рис. 5 видно, что при использовании дифференциального звена (К *0) регулятора можно снизить 
выбросы в зависимостях угловых скоростей звеньев экзоскелета по сравнению со случаем Ку, =0 (рис. 460). 


Итак, рассмотрена возможность управления звеньями экзоскелета нижних конечностей с использованием 
показаний энкодеров и блоков инерциальных датчиков (микромеханических гироскопов и акселерометров). 
Результаты моделирования доказывают действенность данного подхода. 

Обсуждение и заключения. Предлагаемое решение задачи управления движением экзоскелета может быть 
использовано в медицинских приложениях, в том числе для вертикализации пациентов с нарушениями 
функций опорно-двигательного аппарата. 

Итак, данные блоков инерциальных датчиков можно использовать в задаче оценивания состояния звеньев 
экзоскелета — их угловых скоростей и ускорений. При этом нет необходимости в численном 
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дифференцировании измерительной информации энкодеров. Таким образом, в систему управления можно 
вводить обратную связь по угловым ускорениям, что позволяет улучшать переходные процессы при 
управлении движением экзоскелета. 
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